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% BEGINNING OF PSEUDO CODE 

% compute scale factor A, and time constants a, b from physical system 
% parameters 

A = Vmax * Kt/ (Re * Rm + Kt * Kb) * 1 * k; 

pi = 1/Jm/Ie * (-Ie * Rm - Re * Jm + sqrt(Ie A 2 * Rm A 2 - 2 * Re * Rm * Ie * Jm 

+ Re A 2 * Jm A 2 - 4 * Kt * Kb * Ie * Jm)) / 2; 
p2 = 1/Jm/Ie * (-Ie * Rm - Re * Jm - sqrt(Ie A 2 * Rm A 2 - 2 * Re * Rm * Ie * Jm 

+ Re A 2 * Jm A 2 - 4 * Kt * Kb * Ie * Jm)) / 2; 

a = max(-pl,-p2) 
b = min(-pl,-p2) 

% make initial guesses for step durations 

etl = 1; 
et2 = .005; 
et3 = 1; 

% set maximum iteration count 
Nmax = 1000; 
for j = 1 :Nmax 

% save old values of step time intervals 
et3old = et3; 
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et2old = et2; 
etlold^etl; 

% iterate for switch times using fixed voltage level Vmax 

5 

et3 = -log(l .0 / 2.0 - exp(-etl * a) / 2 + exp(-et2 * a)) / a; 
et2 = 1/b * log(2.0) + 3 * et3 - 1/b * log(2 * exp(l/A * b * X) * exp(et3 
* b) - sqrt( 4.0) * sqrt(exp(l/A * b * X)) * exp(et3 * b) * 
sqrt(exp(l/A * b * X)+exp(et3 * b) A 2 - 2 * exp(et3 * b))); 
10 et 1 - - (-2 * A * et2 + 2 * A * et3 - X) / A; 

if norm([et3old - et3 et2old - et2 etlold - etl], inf) <= eps * 2 
break 

end 

15 if j==Nmax 

error([ , error - failure to converge after \ num2str(Nmax),' 
iterations']) 

end 
end 

20 

% round up pulse duration to nearest sample interval, 

% convert to intervals between steps to make sure that voltage 

% requirements will not increase (beyond Vmax). 

25 dtl=ceil((etl-et2)/dt)*dt; 

dt2=ceil((et2 - et3) / dt) * dt; 
dt3=ceil((et3) / dt) * dt; 

etl23 = [etl,et2, et3] 
30 % convert back to total step duration. 
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etl = dtl +dt2 + dt3; 
et2 = dt2 + dt3; 
et3 =dt3; 

% In the following, the original constraints equations involving XF1, XF2, 
% and XF3 have been modified to include a variable voltage level applied 

at 

% each step (instead of the fixed maximum (+/-) Vmax). 
% The original equations for XF1, XF2, and XF3 follow: 

% XFtftend) = VoF^ttend - to) - 2VoF,(tend - ti) + 2V 0 F,(t cnd - t 2 ) 

% XF 2 (tend) = V 0 F2(t te „d - to) - 2V 0 F 2 (tend - ti) + 2V 0 F,(te n d - t 2 ) 

% XF 3 (tend) = V 0 F 3 (tte„d - to) - 2V 0 F 2 (tend " ti) + 2V 0 F,(te nd - t 2 ) 

% And the modified equation including adjustable relative levels of 

voltage 

%L1, L2andL3are: 

% XFi(tend) = L,V 0 Fi(ttend - to) - L 2 V 0 Fi(tend - ti) + L^oF,^ - t 2 ) 
% XF 2 (tend) = LiV 0 F 2 (t tend - to) - L 2 V 0 F 2 (te„d - ti) + LaVoFiCtend - 1 2 ) 
% XF 3 (tend) = LiV 0 F 3 (ttend - to) - L 2 V 0 F 2 (te„d - U) + L^F^d - t 2 ) 

% And the corresponding constraint equations are: 
% XFi(tend) = Finalpos 

% XF 2 (tend) = 0 
% XF 3 (te nd ) = 0 

% Where all of the times indicated have discrete values, e.g. 
corresponding to 

% the controller update rate. 
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% It should be noted that after the digital switch times are fixed, the 
constraint 

% equations derived from the equations above form a linear set of 
equations in 

5 % the unknown relative voltage levels LI, L2 and L3 and any standard 

linear 

% method can be used to solve for the relative voltage levels. In the 
equations 

% for (LI, L2 and L3) that follow, the solution was obtained by algebraic 
1 0 % means (and are not particularly compact.) 

% compute new relative voltage step levels 
% LI, L2 and L3 are nominally assigned to "1", "-2" and "+2", 
respectively 

15 si = X * (exp(-et3 * b) * exp(-et2 * a) + exp(-et3 * a) + exp(-et2 *b ) -exp(-et2 
*b) * exp(-et3 * a) - exp(-et2 * a) - exp(-et3 *b )); 
s2 = 1 / (et2 * exp(-etl * b) * exp(-et3 * a) + exp(-et2 * b) * et3 * 

exp(-etl * a)- et2 * exp(-et3 * a) - et2 * exp(-etl * b) -et3 * 
exp(-etl * a) - exp(-et2 * b) * et3+exp(-et3 * b) * etl * exp(-et2 * 
20 a) + exp(-et3 * a) * etl + exp(-et2 * b) * etl - exp(-et2 * b) * etl * 

exp(-et3 * a) - et3 * exp(-etl * b) * exp(-et2 * a) - exp(-et2 * a) * 
etl - exp(-et3 * b) * etl - exp(-et3 * b) * et2 * exp(-etl * a) + et3 * 

exp(-etl * b) + et2 * exp(-etl * a) + exp(-et3 * b) * et2 + et3 * 
exp(-et2 * a)) / A; 
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LI = si * s2; 



si = 1 / (et2 * exp(-etl * b) * exp(-et3 * a) + exp(-et2 * b) * et3 * 

exp(-etl * a) - et2 * exp(-et3 * a) - et2 * exp(-etl * b) - et3 * 
30 exp(-etl * a) - exp(-et2 * b) * et3 + exp(-et3 * b) * etl * 
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exp(-et2 * a) + exp(-et3 * a) * etl+exp(-et2 * b) * etl - 
exp(-et2 * b) * etl * exp(-et3 * a) - et3 * exp(-etl * b) * 
exp(-et2 * a) - exp(-et2 * a) * etl - exp(-et3 * b) * etl - exp(-et3 * 
b) * et2 * exp(-etl * a) + et3 * exp(-etl * b) + et2 * exp(-etl * a) + 
5 exp(-et3 *b ) * et2 + et3 * exp(-et2 * a)) * X; 

s2 = (exp(-et2 * b) * exp(-etl * a) - exp(-etl * a) - exp(-et2 * b) - 

exp(-etl * b) * exp(-et2 * a) + exp(-etl * b) + exp(-et2 * a)) / A; 
L3 = sl*s2; 

10 si = exp(-etl * a) - exp(-et3 * a) + exp(-et3 * b) - exp(-etl * b) - 

exp(-et3 * b) * exp(-etl * a) + exp(-etl * b) * exp(-et3 * a); 
s2 = X / (et2 * exp(-etl * b) * exp(-et3 * a) + exp(-et2 * b) * et3 * 

exp(-etl * a) - et2 * exp(-et3 * a) - et2 * exp(-etl * b) - et3 * 
exp(-etl * a) - exp(-et2 * b) * et3 + exp(-et3 * b) * etl * exp(-et2 * 
15 a) + exp(-et3 * a) * etl + exp(-et2 * b) * etl - exp(-et2 * b) * etl * exp(- 

et3 * a) - et3 * exp(-etl * b) * exp(-et2 *a ) - exp(-et2 * a) * etl-exp(-et3 * 
b) * etl - exp(-et3 * b) * et2 * exp(-etl * a) + et3 * 

exp(-etl * b) + et2 * exp(-etl * a) + exp(-et3 * b) * et2 + et3 * 
exp(-et2 * a)) / A; 

20 

L2 = si * s2; 

% convert accumulated voltage steps to sequential voltage level 
Vl=Vmax*(Ll); 
25 V2 = Vmax * (LI + L2); 

V3 = Vmax * (LI + L2 + L3); 

% END OF PSEUDO CODE 
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